C programming Add sub functions